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5. Linéarisation des problèmes non linéaires : 

La formulation du filtre présentée plus tôt est basée sur un modèle linéaire des systèmes et elle n'est 
donc pas applicable dans les situations où le modèle du système ou le modèle de la mesure ou bien 
les deux sont non-linéaires. Ainsi, le problème principal dans ces cas est de linéariser d'abord le 
modèle, et puis d'appliquer le filtre standard de Kalman pour obtenir l'état du système. Un certain 
nombre de méthodes ont été développées dans cette direction; ici nous discuterons deux de telles 
approches. 

Quand la linéarisation se fait autour d'une certaine trajectoire nominale dans l'espace d'état qui ne 
dépend pas des données de mesure, le filtre résultant s'appelle le Filtre Linéarisé de Kalman [4]. La 
linéarisation autour d'une trajectoire (estimée) qui est continuellement mise à jour avec les 
estimations d'état résultant des mesures s'appelle le Filtre de Kalman Etendu [5]. Dans les deux cas, 
la linéarisation est faite en utilisant la série de Taylor. 
Nous examinerons maintenant ces approches en détail. 

5.1 Le Filtre de Kalman Linéarisé : [4] 

Dans le filtre linéarisé de Kalman, la linéarisation est faite autour d'une certaine trajectoire 
nominale, qui ne dépend pas des données de mesure, c.-à-d. que l'expansion en série de Taylor 
utilisée pour la linéarisation est évaluée à un certain point nominal connu 

Considérez un modèle non-linéaire d'un système défini comme suit : 

Modèle du processus: Xj^ = ï{X]^-i, ^k-l) "I" ^k-1 (1.56) 

Modèle de mesure: Z^ = h(Xk) + V^ (1-57) 

Là où, /et h sont des fonctions non-linéaires connues, Uj^ est la fonction (le vecteur) de commande 

et Wj^ et Vj^ sont des processus de type bruit blanc non corrélés. La non-linéarité peut résider soit 
dans le modèle du processus soit dans le modèle de mesure soit dans les deux fonctions. 
Supposez qu'une trajectoire approximative Xj^^^^ (figure. L3) puisse être déterminée par un 
quelconque moyen; celle-ci est référée en tant que trajectoire nominale (la trajectoire de référence). 
La trajectoire réelle (actuelle) Xj^ peut être écrite en termes de X]/^^^ et d'erreur b Xj^ comme 
suit: 

Xk = Xk^^^ + Sxk (1.58) 

Les équations, (L56) et (L57) deviennent alors : 

Xfe"«- + ôx, = f(Xfc_i"«- + Ô xj,_„ Uk_i) + Wk_i (1.59) 

Zk = hCxk""'" + Sx,) + Vk (1.60) 



14 



^^ 



APITRE 1 



Filtre de Kalman 




A T raj e c toir e i éelle xi, _^^,.,,-^ 


e- 
fît 


y^i^^ ^ 


^ 
'-^ 


^^y ^ Ti aj ectoire Xoinitiale x^^^ 


E 






^^ (Réelle) - Oùiniiiale) = ÔX|^ 








Temps 


Figure 1.2 : Trajectoire nominale et réelle pour un filtre linéarisé de Kalman 



Par l'application de l'expansion de série de Taylor dans l'équation (1.59) et en supposant que 
Sxj^ est petit, nous allons réaliser une expansion de / autour de Xj^^^^ en ne gardant que le terme 
de premier ordre : 

Xk = X^^^^ + ÔXk = 
f (x;i._i"'"",Uk_i) + — |x=X|t_i"<"" ■ ô X/(._i + terme d'ordres élevés) + Wk_i (1.61) 

ffv nom ,, ^ ^ nom 

=> ô X/^ « Fk_i ô X]^_i + Wk_i (La dynamique linéarisée) (1.62) 

Où 



Fk-i = 
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df, 1 
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.dx\ 
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dX2 
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- 
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^=xnom 



(1.63) 



et 

Wk-N(0,Qk) 

En négligeant le second terme et les termes d'ordres supérieurs, la prédiction de l'état est propagée 
par les équations non-linéaires tandis que les erreurs d'état le sont par un système linéaire séparé. 

Maintenant, la mesure peut être également linéarisé en utilisant l'expansion de la série de Taylor, en 
linéarisant h à X]J^^^ et négligeant les termes d'ordres supérieurs. 
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Zk = (h(x/(."''"^) + — |x=Xfc_i"'"" -S^k + terme d'ordres élevés) + v^ (1.64) 

ô Zk « Zk - h(x,--) 

=> ô Zk ~ Hk Sx]^ + Vk(Équation de mesure linéarisée) (1.65) 



Où 



H. = 



ah 



[dx 



X=Xk' 



5hi 5hi dhi 



dxi dx2 5x3 
5h2 5h2 5h2 



dxi dx-) dx. 



(1.66) 



X=Xfc«°™ 



Vk~N(0,Rk) 



Les équations (1.62) et (1.65) constituent un modèle linéarisé pour le cas discret. Il est clair que ce 
modèle de système linéarisé peut être utilisé pour mettre en application un filtre linéarisé de Kalman 
parce que la relation de la dynamique d'erreur et la relation associée de mesure des erreurs sont 
devenues linéaires. Ici, nous estimons seulement la valeur d'incrément « l'erreur », ainsi les valeurs 
réelles de l'état seront l'incrément estimé plus la valeur nominale à l'instant même. Aussi F et H 
sont obtenus en évaluant les matrices de dérivées partielles (les Jacobiennes de / et h) le long de la 
trajectoire nominale. La position nominale (ou le vecteur d'état) peut changer avec chaque étape du 
processus récursif, ainsi les termes de H et de F peuvent être variables avec le temps et doivent être 
recalculés avec chaque étape récursive. Le problème dans la linéarisation autour de la trajectoire 
nominale est que la déviation de la trajectoire réelle de la trajectoire nominale tend à augmenter 
avec le temps. À mesure que la déviation augmente, les poids des termes d'ordres supérieurs dans 
l'expansion de la série de Taylor de la trajectoire augmentent. 

La déviation de la trajectoire de référence est le vecteur d'état et les mesures dans le modèle linéaire 
sont les vraies mesures moins celles qui ont été prédites par la trajectoire nominale en l'absence du 
bruit. 

Ce type de filtre est difficile d'utilisation pour des missions prolongées parce qu'après une certaine 
durée, la trajectoire de référence peut diverger en un point où l'hypothèse linéaire n'est plus valide à 
travers la variation du vecteur d'état. 

Enfin, le filtrage linéarisé a l'avantage de permettre généralement une exécution en temps réel, 
cependant, il est moins robuste vis-à-vis des approximations non-linéaires des erreurs que le filtrage 
étendu. Un remède simple et efficace pour le problème de la déviation réside dans le remplacement 
de la trajectoire nominale par la trajectoire estimée, ce qui ramène au filtre de Kalman étendu. 
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5.2 Le Filtre de Kalman Etendu : [5] 

Le filtre de Kalman étendu « EKF » a été développé par Stanley F. Schmidt. Il représente 
probablement l'approche la plus commune et la plus populaire pour traiter un système non linéaire. 
Son fonctionnement consiste simplement à linéarisé tous les modèles non-linéaires de sorte que le 
filtre linéaire traditionnel de Kalman puisse être appliqué. L'EKF est devenu une approche standard 
pour un certain nombre d'applications d'estimation non linéaire. 

EKF est similaire à un filtre linéarisé de Kalman sauf que la linéarisation a lieu autour de la 
trajectoire estimée du filtre plutôt que de la trajectoire nominale pré-calculée (figure. 1.4). Ceci 
signifie que les dérivés partielles sont évaluées le long de la trajectoire qui a été mise à jour avec les 
estimations du filtre; ce qui dépend des mesures. Ainsi, le gain du filtre dépendra de la séquence 
d'échantillons de mesure et ne sera pas prédéterminé par les prévisions du modèle du processus: 

Modèle non linéaire du processus : Xj^ = f(xi^_j^, I^k-l) "I" ^k-1 (1-67) 

Modèle de mesure: Z^ = h(Xk) + Vk (1.68) 



L'approximation de Taylor de /est faite autour de l'estimation de l'instant précédent Xk_i 
^f(x,k) , 



F(x.k) 



dx 



IX=Xk_i 



(1.69) 



L'approximation de Taylor de h est faite à la position (ou à l'état) prédite correspondante 



H(x,k) 



ah(x,k) 
dx 



\X=X^, 



.(1.70) 



Comme dans le cas du filtre linéarisé de Kalman, le développement limité donne cette fois-ci : 

Xk ~ Xk" + Fk-i(Xk-i - Xk-i)+Wk_i (1.71) 

Zk « Zk + H(Xk - Xk~) + Vk (1.72) 
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Figure 1.3: Trajectoire estimée (nominale) et réelle pour un filtre de Kalman 


étendu 
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Les équations (1.71) et (1.72) constituent un modèle linéarisé pour le cas discret. En général, l'EKF 
est difficile en raison du bouclage (le feedback) de la mesure au modèle du processus, mais il arrive 
à mettre à jour la trajectoire utilisée pour la linéarisation pendant que le temps évolue. 

L'avantage du EKF est qu'il est plus exploitable pour les missions prolongées. Mais il peut encore 
parfois aboutir à une trajectoire pire que la trajectoire nominale particulièrement dans les cas où 
l'incertitude initiale et les erreurs de mesure sont grandes. 

Néanmoins, le filtre linéarisé et le filtre étendu de Kalman sont utilisés dans des applications 
différentes, chacun ayant ses propres avantages et inconvénients. 

La distinction précise entre les deux filtres (linéarisé et étendu) est basée sur la fonction de mesure 
h(x~) , et plus précisément sur la façon dont elle est mise à jour : à partir de la trajectoire corrigée 
(filtre étendu) ou de la trajectoire nominale (filtre linéarisé). Lorsque /i(x~) est calculée avant que 
les corrections ne soient faites aux sorties inerti elles, le filtre est alors un filtre de Kalman linéarisé 
ordinaire. Si /i(x~) est calculée après que les corrections aient été faites, le filtre est un filtre de 
Kalman étendu. En général, l'EKF est préféré particulièrement quand la durée de la mission est 
longue, parce que dans ce cas la trajectoire de référence peut diverger de la vraie trajectoire au-delà 
des limites acceptables. 

Figure (1.5) montre les différentes étapes de l'algorithme d'estimation des paramètres du système 
non linéaire. 
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Figure 1.5 : Extension du filtre de Kalman aux systèmes non linéaire 
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5.2.1 Quelques aspects du filtre de Kalman étendu : 

Le filtre de Kalman étendu est probablement le filtre le plus largement répandu pour un système 
non linéaire. Cependant, il présente certains inconvénients et défauts : 

1. Une opération centrale et essentielle effectuée dans l'EKF est la propagation d'une variable 
gaussienne (GRV) par la dynamique du système. Dans l'EKF, la distribution d'état est approximée 
par un GRV, qui est alors propagé analytiquement par une linéarisation du premier ordre du 
système non linéaire. Les termes négligés dans la linéarisation peuvent être relativement grands ce 
qui peut présenter de grandes erreurs 

2. dans l'estimation de la moyenne et de la covariance a posteriori du GRV transformé. 
Ceci peut mener à une performance sub-optimale et parfois à la divergence du filtre. 

3. Le coût calculatoire de l'EKF est intensif par rapport au filtrage linéarisé de Kalman. 

Puisque la linéarisation est faite autour des estimations obtenues à partir du filtre, nous ne pouvons 
pas calculer le paramètre de filtre à l'avance, ce qui augmente la charge de calcul en temps réel. 

4. La dérivation des matrices Jacobiennes n'est pas triviale dans la plupart des applications et 
introduisent souvent ensuite des difficultés d'implémentation significatives. 

6. Conclusion : 

Ce chapitre a été consacré à la présentation du filtre de Kalman qui consiste le noyau de plusieurs 
algorithmes de pistage. Au début on a présenté le filtre de Kalman dans le cadre linéaire, et après on 
a expliqué deux méthodes utilisé pour la linéarisation des problèmes non linéaire. 

Il faut noter que L'estimateur le plus largement répandu pour les systèmes non linéaires est 
probablement le filtre de Kalman étendu (EKF). 
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1. Introduction : 

Le filtrage est la mise en forme d'un signal à des fins très diversifiées. Pendant longtemps son rôle a 
consisté surtout dans l'élimination des bruits superposés aux signaux utiles et sa mise en œuvre a 
été du ressort des électroniciens. 

Après l'avènement de l'automatique et des calculateurs numérique, le filtrage est devenu un outil 
fondamental. Il garantit l'équivalence analogique -numérique. Une fois la conversion numérique 
obtenue, le filtrage permet l'extraction d'informations utiles pour la reconnaissance des formes dans 
l'élaboration de la loi de commande des systèmes industriels. 

Il existe deux espèces de filtrage appelées le filtrage fréquentiel et le filtrage optimal. Le filtrage 
fréquentiel comporte lui-même deux fonctions : le filtrage analogique et le filtrage numérique. Le 
filtrage analogique demeure un élément indispensable dans la synthèse des filtres numériques et un 
moyen de réduction de la bande passante pour le codage des signaux continus. De même, le filtrage 
numérique résoudre le problème de la mise en forme d'un signal et permet de réaliser 
l'interpolation et l'extrapolation, et peut être un filtre passe bande. 

Le filtrage optimal admet deux théories importantes appelées théorie de Wiener et théorie de 
Kalman. 

En 1950, Wiener a développé sa théorie en traitant seulement les signaux stationnaires sous leur 
forme fréquentielle. Il résoudre le problème de l'élimination du bruit parasite inhérent à la 
transmission et fait de l'estimation. Son inconvénient réside dans le non récursivité, ce qui rend un 
peu difficile la rapidité du système. 

En 1960, une théorie s'est développée, dite théorie de Kalman, qui est une extension de la théorie de 
Wiener et représente plusieurs avantages. 

Filtre de Kalman : Le filtre de Kalman représente une extension de la théorie de Wiener 
applicable aux signaux non stationnaires sous leur forme temporelle en présence des conditions 
initiales et d'entrées déterministes. Il résout le problème de filtrage linéaire et se présente sous la 
forme d'un ensemble d'équations récurrentes plus faciles à résoudre sur calculateur numérique, ce 
qui explique le succès remarquable de l'approche proposée par Kalman. Sa réalisation fournit non 
seulement l'estimée optimale, mais aussi la variance de l'erreur de l'estimation. C'est un 
observateur donnant la prédiction ou l'estimation du vecteur d'état. Lorsque les variances des 
bruits sont connues, c'est le meilleur observateur linéaire, de plus, si les bruits sont blancs 
gaussiens, linéaires ou non, c'est lui dont la variance de l'erreur d'estimation est la plus faible. 

Le filtre de Kalman s'applique au système dynamiques linéaires, connus ou discrets, ont le bruit de 
mesure est blanc. 

L'estimation de Kalman et ses nombreuses dérivées ont été développée avec succès dans le monde 
de l'aérospatial à de nombreux problèmes, comme la poursuite radar, l'estimation de trajectoires 
d'orbites... [1] 

Après la parution des publications fondamentales de Kalman et Bucy pour la théorie de filtrage 
linéaire, un nombre très important de travaux fut consacré à ce problème, chaque auteur décrivant 
son algorithme en exploitant des méthodes comme les moindres carrées, le maximum de 
vraisemblance et d'autres méthodes statistiques classiques. Cependant, ces méthodes statistiques 
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laissent dans l'ombre la structure probabiliste du problème de filtrage, structure qui est 
fondamentale. [2] 

2. Dérivation du filtre de Kalman : 

2.1 Formulation du problème : 

Le filtre de Kalman est caractérisé par les mesures qui sont générés par un système dynamique qui 
est présenté par un certain modèle [7]. Mathématiquement le filtre de Kalman peut être formulé par 
deux équations : 

L'équation d'état, qui présente l'évolution d'état d'un objet durant le temps et l'équation de mesure, 
qui relie les mesures à cet état. 

Nous considérons un système dynamique linéaire et discret, l'équation d'état est donnée par : 

Xk+i = FkXk + GkUk + Wk (1.1) 

> Xk est le vecteur d'état qui incluse les quantités à estimer, comme la position, la vitesse et 
l'accélération. 

> Fk est la matrice de transition. Elle décrit l'évolution dans le temps du vecteur d'état, en 
absence de l'entrée de contrôle et du bruit. 

> Uk est l'entrée de contrôle ou le processus générateur, elle est supposée être connue. 

> Gk est une matrice qui décrit comment l'entrée à l'instant k, contribue au vecteur d'état à 
l'instant k+1. 

> Wk est le bruit de processus supposé indépendant, blanc et de moyenne nulle. 



X(k) 



H 



Paramètres de 
bruit 




Observation z(h) 



Bruit blanc additif v(k) 



Figure 1.1 : Modèle d'observation 



Zk = HkXk + Vk 

Où 

> Hk est la matrice de mesure. 

> Vk est le bruit de mesure supposé indépendant de Wk, blanc et de moyenne nulle. 



(1.2) 
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E[wk ] = (1.3) 

E[vk] = (1.4) 

E[vkw/"] = 0; V k, 1 (1.5) 

eKw/'] = Qkô(k, 1) (1.6) 

E[v^vJ] = Rkô(k, 1) (1.7) 

et 

E[xowJ] = V k (1.8) 

E[xovJ] = Vk (1.9) 

Qk et Rk étant respectivement les matrices de covariance du bruit de processus et du bruit de 
mesure. 

Le problème consiste à estimer le vecteur d'état x^ compte tenu des informations disponibles à 
l'instant n, postérieur, antérieur, ou identique à l'instant k. 

On peut considérer les cas suivants: [2] 

• k=n: il s'agit dans ce cas de déterminer une estimée de l'état, compte tenu de toutes les 
mesures disponibles à l'instant considéré n. c'est le cas du filtrage. 

• k<n: en utilisant les mesures disponibles jusqu'à l'instant n, on essaye d'estimer l'état à un 
instant k antérieur à n. on fait alors un lissage ou une interpolation. 

• k>n: il s'agit dans ce cas d'estimer la valeur du vecteur d'état à un instant k dans le futur, 
c'est ce qu'on appelle la prédiction ou l'extrapolation. 

Nous noterons pour ces différents cas, l'estimée par: X^+i/n, c'est à dire l'estimée à l'instant k+1 
compte tenu des informations disponibles à l'instant n. 

L'estimée optimal au critère de l'erreur quadratique moyenne minimale est donnée par l'espérance 
mathématique conditionnelle notée comme suit: [5] 

Xk+l/n = E[xk+i/zi Zn] (1.10) 

L'évolution du vecteur d'état estimée Xk+l/n ? est caractérisée par la matrice de transition F^- En 
effet en substituant l'équation (1.1) dans (1.10), on obtient: 

E[xk+i/zi Zk] = FkE[xk/zi,...,Zk] + GkE(uk+i/zL. -.Zk] + 

E[vk+i/zi, ... , Zk] (1.11) 
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Soit encore : 

Xk+i/k = Fk Xk/k + GkUk (1.12) 

Étant donné que : 

[Vk+l 



z(l) 



Zk 



= (1.13) 



l'objectif est d'avoir une estimation récursive du vecteur d'état qui, à partir d'une estimation à 
l'instant k, nous fournisse une nouvelle estimation à l'instant k+l,en utilisant la mesure à cet instant. 
On adoptera une estimation linéaire de la forme: 

^k+l/k+1 = ^k+l/k + Kk+i [Zk+i — Hk+iXk+ i/kj (1.14) 

La relation (1.14) exprime le fait que la nouvelle estimée du vecteur d'état à l'instant k+1, est une 
mise à jour de l'estimée à l'instant k. cette mise à jour tient compte de l'écart entre la mesure 
effective et la mesure prédite. 

Nous devons donc déterminer le poids Ki^_^;[ à accorder à cette mise à jour de sorte que l'erreur au 
sens des moindres carrés, entre le vecteur d'état et son estimée, soit minimale. Le paramètre K^+i 
est appelé gain du filtre de Kalman. 

L'erreur d'estimation est définie par: 

Xk+i = Xk+i — Xk+i/k+l (1-15) 

Il s'agit donc de minimiser la quantité: 

Pk+i/k+1 = E[(Xk+i - Xk+ i/k+i)(Xk+i - Xk+ 1/k+i) ] = E[xk+iXi^+iJ (1-16) 

fk+l/k+1 ^st appelée matrice de covariance de l'erreur d'estimation. Le filtre de Kalman est donc 
un filtre à minimum de variance. C'est par abus de langage que l'on parle de minimiser cette 
quantité matricielle. Nous y reviendrons dans le prochain paragraphe. 

2.2 Expression de la matrice de covariance : P^+i/k+i [5] 

Nous allons, à partir des équations d'état et de la relation linéaire de l'estimation exprimer la matrice 
de covariance P^+i/k+i en fonction du gain Kj^+x- 

Reprenons les relations (1.1) et (1.12). 
Xk+i = FkXk + GkUk + Wk 
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^k+l/k — Fk ^k/k + ^kUk 
En les soustrayant, il vient: 

Xk+i - Xk+i/k = Fk[xk - Xk/k] + Wk (1.17) 

D'après la relation (1.16) définissant Pk+i/k+i, on a: 

Pk+i/k = E[(Xk+i - Xk+ i/k)(Xk+i - Xk+ i/\,y] (1.18) 

D'où, en prenant les espérances mathématiques des deux membres de l'équation (1.17) 

Pk+i/k = FkE[(Xk - Xk/k)(Xk - Xk/k)'']Fj + E[(wkwJ)] (1.19) 

Cette relation peut se simplifier en tenant compte de la relation (1.6) et du fait que: 

E[(Xk+i - Xk/k)(Xk+i - Xk/k)"^] = Pk/k (1-20) 

Il vient alors: 

I\+l/k = F"kPk/kF"k + Qk (1.21) 

Nous devons à ce stade du calcul exprimer Pk+i/k+l ^^ fonction de Pk+i/k- 

Pour ce faire, reprenons l'expression (1.15) de l'erreur Xk+iet remplaçons l'estimée Xk+i/k+i par 

son expression donnée par la relation (1.14), on obtient: 

Xk+l/k+l = Xk+i — Xk+i/k — Kk+i[Hk+iXk+i + Vk+i — Hk+iXk+ l/kj 

= - Kk+iHk+i)(xk+i - Xk+ i/k) - Kk+iVk+i (1.22) 

Ou Pk+i/k+i = E[xk+i/k+iXk+i/k+iJ (1.23) 

Si on substitue l'expression (1.22) dans la relation (1.23), il vient en tenant compte de la relation 
que: (AB)"^ = B^A"^ que : 

Pk+i/k+1 = ~ Kk+iHk+i)E[(Xk+i — Xk+i/k)(Xk+i ~Xk+i/k) ](I — Kk+iHk+i) 

+ Kk+iE[Vk+ivJ+i]Kj+i (1.24) 

Soit encore: 

Pk+i/k+1 = — Kk+iHk+i)Pk+ i/k(I — Kk+iHk+i) + Kk+iRk+iKj^+i (1.25) 
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Pk+l/k+l — Pk+l/k ~ Kk+lHk+lPk+1/k ~ Pk+1/kHk+iKk+i + 

Kk+i[Hk+iPk+i/k+iHk+i + Pk+i]Kk+i (1.26) 

2.3 Expression du gain du filtre de Kainnan: [5] 

Nous devrons chercher l'expression du gain Kk+i qui minimise le critère 

J = E[xJ+i/k+iXk+i/k+i] (1.27) 

Notons au passage que nous avons: 

Trace Pk+i/k+i = ^[^k-\- i/k+i^k+i/k+ij = J (1.28) 

La relation (1.26) est une forme quadratique en Kk+i- Nous obtiendrons la valeur du gain optimal 
en résolvant l'équation suivante: 

d](k) 

= 
aK(k) 

L'optimisation de ce problème peut être faite de différentes manières. L'une de ces manières se base 
sur les formules du calcul différentiel des matrices. En utilisant les relations suivantes: 

'^^^7/^"^^ = B^ (AB doit être carré) (1.29) 

aCTraceCACA'^)) 

— = 2AC (C doit être symétrique) (1.30) 

oA 

On obtient 

a(TraceP,+ i/,+i) _ 

^^^— --2(Hk+iPk+i/k) + 

2Kk+i(Hk+iPk+i/kHk+i + Rk+i) (1.31) 

Soit encore : 

~0 - Kk+iHk+i)Pk+i/kHk+i + Kk+iRk+i = (1.32) 

D'où 

Kk+i = Pk+i/k^k+i [Hk+iPk+i/kHk+i + Rk+i]~ (1.33) 

Et 
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Pk+l/k+l = Pk+l/k ~ Pk+ l/kHk+iHk+iPk+ 1/kHk+i + Rk+iHk+iPk+ 1/k (1-34) 

Dans le cas continu, cette équation prend la forme d'une équation différentielle de Ricatti. 

C'est pour cette raison, et par analogie que la relation (1.34) est appelée équation de Ricatti 
discrète. 

Elle peut être réécrite sous la forme suivante: 

Pk+l/k+l = Pk+l/k ~ Kk+iHk+iPk+i/k = [I — Kk+iHk+i]Pk+i/k (1.35) 

La matrice Kk+iHk+iPk+i/k ^^t définie positive ou à la rigueur définie semi-positive. 
Nous pouvons en outre écrire l'équation récursive de mise à jour de l'estimation comme suit: 

Xk+i = Xk + Kk[terme de correction] (1.36) 

Il apparaît ainsi que: 

1. Pour Rk+i constant, si P^+i faible, le gain sera faible. Ainsi, on fera davantage confiance à 
l'estimation obtenue à partir du modèle. Si par contre P^+i est élevé, ce qui traduit notre 
faible confiance dans le modèle K sera élevé et la contribution du terme de correction 
pondéré par le gain, sera plus forte. On se basera donc davantage sur les mesures pour la 
mise à jour. 

2. Pour Pk+i constant, si R^+i est faible, nous aurons des mesures faiblement bruitées. La 
valeur élevée du gain donnera plus de poids aux mesures. Si R^+i est élevé,le gain sera 
faible et le poids du deuxième terme sera plus faible. 

2.4 Initialisation du filtre de Kalman: [3] 

Pour pouvoir utiliser l'ensemble des équations récurrentes constituant le filtre de Kalman, on doit 
choisir les conditions initiales: Xq/q et Po/o-On peut prendre: 

xo/o = E[xo] (1.37) 

Po/0 = Po = E[xo - Xo/o)(xo - Xo/o) ] (1-38) 

Le choix des valeurs initiales est délicat. En effet, un mauvais choix de Xq, c'est à dire, à la limite 
une valeur arbitraire n'est pas catastrophique en ce sens que l'algorithme excité par les mesures 
apportera les corrections nécessaires. Par contre le traitement des mesures n'améliore pas la 
covariance de l'erreur au fur et à mesure de son traitement. 

2.5 Notion d'innovation: [5] 

Reprenons l'équation (1.14) de l'estimation récursive: 
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^k+l/k+l — ^k+l/k + Kk+l[2^k+l ~ Hk+iXk+i/k] 

Zk+i représente la mesure effective et H^+iXk+l/k 1^ prédiction de la mesure. Si cette prédiction 
est prédiction est parfaite, la correction apportée par la quantité 

^k+1 = Zk+i - Hk+iXk+i/k (1.39) 

sera nulle. On appelle z^+i l'innovation. On peut montrer que si le filtre est optimal, le processus 
Zk+i est un bruit blanc de valeur moyenne nulle, c'est à dire qu'il ne contient plus d'informations 
pouvant enrichir la mise à jour de l'état. 

Ainsi, en testant la « blancheur » de l'innovation on peut apprécier le degré d'optimalité et donc les 
performances du filtre. 

3. Mise en œuvre du filtre de Kalman [2] 

On peut résumer l'ensemble des équations récurrentes constituant le filtre de Kalman dans les étapes 
suivantes : 

3.1 Prédiction: 

1. A partir du vecteur d'état à l'instant antérieur, la prédiction du vecteur d'état est 
effectuée selon: 

Xk+i/k = Fk Xk/k + GkUk (1.40) 

2. Calcul de la matrice de covariance correspondant à l'état prédit: 

Pk+i/k = FkPk/kFj + Qk (1-41) 

3.2 Estimation: 

1 . Mise à jour du vecteur d'état: 

^k+i/k+1 = Xk+i/k + Kk+iZk+i (1-42) 

Ou Zk+i est l'innovation définie en (1.39) et Kk+iest le gain de Kalman donnée par: 

Kk+i = Pk+i/kHk+iSk+i (1-43) 

S(k + 1) est appelée matrice de covariance de l'innovation. Elle est donnée par: 

Sk+1 = Hk+iPk+i/kHk+i + Rk+i (1.44) 
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2. Mise à jour de la matrice de covariance de l'état estimé 
la matrice de covariance correspondant à (1.42) est calculée selon: 



Pk+l/k+1 — Pk+l/k ~ Kk+iSk+iK^+i 



(1.45) 



On peut résumer l'algorithme de filtre de Kalman dans le cycle suivant en cinq étapes de base qui 
sont: 

> Extrapoler la position et la vitesse de la cible. 

> Extrapoler les erreurs d'estimation 

> Calculer le gain du filtre. 

> Mettre à jour l'estimation de vecteur d'état. 

> Mettre à jour l'estimation pour les nouvelles données (mesure). 

Le schéma de la figure 1.2 résume un cycle de calcul de l'état estimé d'un système linéaire par le 
filtre de Kalman. 
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Soitie 
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Figure 1.2 : Un cycle pour l'estimation de l'état d'un système linéaire (filtre de Kalman) 



4. Les modèles cinématiques : 

Les modèles d'état cinématiques sont définit par la mise de quelques dérivations de position à Zéro. 
Il existe deux modèles: modèle de deuxième ordre (white noise accélération) et le modèle de 
troisième ordre (Wiener process accélération). [6] 

4.1 Modèle à vitesse constante (deuxiènne ordre) 

Ce modèle est plus adapté au mouvement d'une cible qui se déplace à une vitesse constante. Un 
objet déplace avec une vitesse constante, son mouvement est présenté par l'équation: 
Xk = 
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La position évolue, en absence du bruit, selon un polynôme (dans ce cas de ordre), ce modèle est 
appelé le modèle polynomiale. En pratique, la vitesse subit des changements aléatoires, qui peuvent 
être modélisés par un bruit blanc d moyenne nulle. 

Si on suppose que la poursuite se fait dans un plan (X,Y), le vecteur d'état relatif à la direction x 
sera formé de deux composantes qui sont la position et la vitesse dans cette direction: 

Xk = [% x]T" (1.46) 

L'équation d'état pour un filtre de Kalman du deuxième ordre est: 

Xk+i = FrXr + GkUk (1.47) 

La matrice de transition est donnée par: 
[1 Tl 



Lo iJ 



(1.48) 



Oîi T présente le temps entre deux mesures, appelée aussi le temps de mise à jour. 

Le terme G^u^ est introduit afin de prendre en considération les fluctuations de vitesse. 

Uk est supposé être une valeur scalaire, blanche de moyenne nulle et de variance O p , qui 

représente l'accélération supposée constante durant la k^™^ période d'échantillonnage. On a: 



G = 



j2 



(1.49) 



E[u(k)uT(l)] = a%ô(k, 1) (1.50) 



etQ(k) = K[Gu(k)uT(l)GT] = 



l'T'4 lyS 
4 2 



(1.51) 



Il n'existe pas de règle pour le choix de Qp . On peut cependant le choisir de façon empirique de 
l'ordre de grandeur de l'accélération maximal a^ :0.5 a^ < Qp < a^ 

4.2 Modèle à accélération constante (troisiènne ordre) 

Ce modèle est approprié au mouvement d'une cible manoeuvrante. Il suppose que l'accélération est 
constante et utilise un bruit de processus pour modéliser ses fluctuations éventuelles. L'équation 
d'état correspondant à ce modèle est similaire à l'équation (1.47) . 

Les composantes du vecteur d'état x(k) sont dans ce cas: la vitesse et l'accélération. 

Xk = [x.x.x]'^ (1.52) 
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La matrice de transition Fj^ est donnée par: 
1 



F = 



1 T -T^ 
2 

OIT 
1 



(1.53) 



Les fluctuations de l'accélération sont modélisées par le bruit de processusG(k)v(k), où v(k) 
représente l'incrément de l'accélération durant la k^"^^ période d'observation. 



Il est supposé une séquence blanche de moyenne nulle avec une varianc O yY avec: 



G = 



j2 

— T 1 

2 



(1.54) 



La matrice de covariance du bruit de processus est donnée par 



Q(k) = 



1 j4 
4 

2 

— T 

■ 2 



r2n 

2 2 



1^3 T^ 



T 
1 



(1.55) 



Les changements de l'accélération sont de l'ordre de a y. Pour avoir un modèle proche du modèle à 
accélération constante il faut choisir une intensité de bruit Gy petite de façon que les changement de 
l'accélération A a^ pendant une période restent petits par rapport à l'accélération actuelle. 

En pratique en prendra: 0.5 A a^ < o^ < A a^ . 
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